float64 upper_joint
float64 wrist_joint
